FULL-CLOSED CONTROL APPARATUS 



BACKGROUND OF THE INVENTION 
l^Field of the InventLon 

The present invention relates to a full-closed control apparatus for 
performing position control based on a position signal of a load driven by a 
motor. 

2.Description of the Related Art 

Generally, fuU-closed control for performing speed control based on a 
speed signal of a motor and performing position control based on a position 
signal of a load driven by the motor is required for accurate positioning. If 
rigidity in coupKng the motor and the load to each other is low, it is however 
impossible to achieve high-speed control by ordinary fuU-dosed control. 
This is because a control system vibrates at a frequency near an 
antiresonance frequency of a mechanical system when the gain of a position 
controller is increased, that is, because the upper limit of the gain of the 
position controller becomes lower than that in semi-closed control. To solve 
this problem, the present applicant has proposed a fuU-closed control 
apparatus shown ia Fig, 5 in Japanese Patent OPI publication No. 
2001-309676. 

In Pig. 5, Uie reference numeral 1 designates a motor-including 
mechanical system which has an equivalent rigid model 5, a mechanical 
resonance system 6, a load principal vibration system 7, and an integration 
8, Incidentally, J is inertia of a movable portion of the mechanical system, 
D is a coefficient of viscous faction of an equivalent rigid system, cOr is an 
angular frequency of resonance, ^ is a viscosity coefiBLcient of resonance, 
is an angular frequency of antiresonance, and C* is a viscosity coefficient of 
antiresonance. Hie reference numeral 2 designates a load vibration 
suppression compensator which has an ampKtude adjuster 9, and a 
band-pass filter 10. The reference numeral 3 designates a position 
controller. The reference numeral 4 designates a speed controller. A 



difference signal El obtained by subtracting a load position signal Xl from a 
position command Xr is multiplied by a position control gain to thereby 
obtain a speed command basic signal Vrb- A difference signal obtained by 
subtracting a speed command Vr from a load speed signal Vl is input into 
the band-pass filter 10. An output of the band-pass filter 10 is input into 
the amplitude adjuster 9. A signal obtained by adding a speed command 
compensatory signal Vrh as an output of the amphtude adjuster 9 to the 
speed command basic signal Va is set as a new speed command Vr. A 
difference signal obtained by subtracting a motor speed Vm frxim the speed 
command Vt is input into the speed controller 4. An output of the speed 
controller 4 is set as a torque command Tr. The motor-indudmg 
mechanical system 1 is driven on the basis of Tr. 

In the related art, if the gain of the speed controller is sufficiently 
high, the gain of the equivalent rigid system speed loop model is 
approximately equal to 1 in a low-frequency region. Accordingly, the 
difference signal Via obtained by subtracting the speed command Vr from 
the load speed Vl can be regarded as an estimated signal of vibration 
contained in the load speed. When VLd is phase-adjusted by the band-pass 
filter and gain-adjusted by the amphtude adjuster to cancel a vibration 
mode contained in the speed command basic signal, a position loop can be 
stabilized even in the case where the gain of the position controller is hi^. 

In the related art, however, if the gain of the speed controller cannot 
be increased so suflGlciently, the gain of the equivalent rigid system speed 
loop model is lower than 1 in a low-frequency region. For this reason, a 
low-firequency component is contained in the difference signal VLd obtained 
by subtracting the speed command V, from the load speed Vl- On the other 
hand, because the band-pass filter is also used as a phase adjuster, a 
predetermined phase delay is given to the oscillation frequency fe of the 
position loop. Accordingly, the center frequency fb of the pass band in the 
band-pass filter becomes lower than the oscillation frequen<7 fd of the 
position loop. When, for example, the band-pass filter is constituted by a 



combination of a two-stage lowTpass filter (l/d+Tfs)) and a two-stage 
high-pass filter (Tis/d+Tfs)) in the case where the oscillation frequency fa of 
the position loop is 40 Hz, the center freqpiency to of the pass band in the 
band-pass filter is 16.6 Hz (Fig. 6) because a phase delay of 90*^ is given to a 
5 point of 40 Hz. 

Because the speed command compensatoxy signal Va contains" a" 
low-frequency component with a large amplitude as described above, there 
is a problem that low-frequency vibration or overshooting is apt to occur (Pig. 
8). 

10 - SUMMARY OF THE INVENTION 

Therefore, an object of the invention is to provide an apparatus by 
which the problem in the related art can be solved and by which while the 
vibration of a position loop can be suppressed, the position control gain can 
be increased to achieve speedy and accurate positioning. 

15 To achieve the foregoing object, the invention provides a full-closed 

control apparatus for performing speed control based on a speed signal of a 
motor and performing position control based on a position signal of a load 
driven by the motor, including' an equivalent rigid system speed loop model; 
a band-pass filter; an amplitude adjuster; and a unit for inputting a speed 

20 command of a speed control loop into the equivalent rigid system speed loop 
model, inputting a difference signal obtained by subtracting an output of the 
equivalent rigid system speed loop model from a speed signal of the load into 
the band^pass filter, inputting an output of the band-pass filter into the 
amplitude adjuster and outputting a signal obtained by adding an output of 

25 the amplitude adjuster to an output of a position controller, as a new speed 
command. 

The iQvention also provides a full-closed control apparatus for 
performing speed control based on a speed signal of a motor and performing 
position control based on a position signal of a load driven by the motor, 
SO including- an all-pass filter; a band-pass filter; an amplitude adjuster; and a 
unit for inputting a difference signal obtained by subtracting a speed 
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command of a speed control loop from a speed signal of the load into the 
aU-pass filter, inputting an output of the aU-pass filter into the band-pass 
mter, inputting an output of the band-pass filter into the amplitude adjuster 
and outputtdng a signal obtained by adding an output of the ampHtude 
S adjuster to an output of a position controller, as a new speed command. 

The invention further provides a full-dosed control apparatusTof 
performing speed control based on a speed signal of a motor and performing 
position control based on a position signal of a load ddven by the motor, 
including: an equivalent rigid system speed loop model; an aU-pass filter; a 
10 band-pass filter; an ampHtude adjuster; and a unit for inputting a speed 
command of a speed control loop into the equivalent rigid system speed loop 
model, inputting a difference signal obtained by subtracting an output of the 
equivalent rigid system speed loop model irom a speed signal of the load into 
the all-pass filter, inputting an output of the all-pass filter into the 
15 band-pass filter, inputting an output of the band-pass filter into the 
amplitude adjuster and outputting a signal obtained by adding an output of 
the amplitude adjuster to an output of a position controUer, as a new speed 
command. 

BRIEF DESCRIPTION OF THE DRAWINGS 
Fig. 1 is a diagram showing a first embodiment of the invention. 
Fig. 2 is a diagram showing a second embodiment of the invention. 
Fig. 3 is a diagram showing a third embodiment of the invention. 
Fig. 4 is a block diagram of an equivalent rigid system speed loop. 
Fig. 5 is a diagram showing a control system in the related art. 
25 Fig. 6 is a Bode diagram of the band-pass filter depicted in Figs. 1 and 

5. 

Fig, 7 is a Bode diagram of a phase and gain adjuster constituted by a 
combination of the band-pass filter and the aU-pass filter depicted in Figs. 2 
and 3. 

30 Fig. 8 is a graph showing a result of simulation in the related art. 

Fig. 9 is a graph showing a result of simulation in the first 
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embodiment of the invention. 

Fig. 10 is a graph showing a resxilt of simulation in the second 
embodiment of the invention. 

DESCRTPnON OF THE PREFERRED EMBODIMENTS 
5 Specific embodiments of the invention will be desctibed below. Fig. 1 

shows a first embodiment of the invention, A control system shown in Fig,- 
1 is configured by addition of an equivalent rigid system speed loop model 
12 to the control system (Pig, 5) in the related art. In Pig, 1, a difference 
signal VLd obtained fi-om subtracting an out))ut Vlo of the equivalent rigid 

10 system speed loop model 12 firom a load speed signal Vl Is input into the 
band pass filter 10. An output of the band-pass filter 10 is input into the 
amplitude adjuster 9. A signal obtained by adding a speed command 
compensatory signal Vrii as an output of the amplitude adjuster 9 to the 
i^eed command basic signal V,b is set as a new speed command Vr. 

15 A pxindple for suppression of vibration of a position loop wiU be 

described below. The equivalent rigid system speed loop model Gvo(s) is an 
input/output transfer function of a dosed loop constituted by a combination 
of a speed controller 4 and an equivalent rigid system 5 as shown in Fig. 4. 
That is, Gvo(s) is given as follows, 

20 [Expression l] 

r (^s - ^^^^^ Js I D , Cv(s) ... 

When the mechanical system is a rigid system on the assumption that 
there is neither disturbance nor identification error, Via (= Vl - Vlo) is zero 
because it is obvious that Vu) is equal to Vl» Accordingly, when the 
25 mechanical system is an inertial system, Vi^ contains no signal but a 
vibration signal (frequency^ fa) of load speed. When the phase and gain of 
Yhd are adjusted by the band-pass filter and the amplitude adjuster to 
cancel a vibration mode contained in the speed command basic signal Vh» 
the position loop can be stabilized even in the case where the gain of the 
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position controEer is high. Because VLd contains no lowfrequency 
component, that is, because Vuh contains no low-firequency component, 
addition of the speed command compensatory signal Vrh to the speed 
command basic signal Vrb exerts no influence on response characteristic in a 
5 low-fceqpiency region* That is, the problem that low-firequency vibration or 
overshooting is caused by combination of the load vibration suppression 
compensator can be avoided (Pig, 9). 

Fig. 2 shows a second embodiment of the invention^ A control 
system shown in Fig. 2 is configured by addition of an all^ass filter 11 to 

10 the control system (Pig. 5) in the related art. In Fig. 2, a difiference signal - 
Vm obtained by subtracting a speed command Vr from a load speed signal 
Vl is input into the all-pass filter 11, An output of tlie all^ass filter 11 is 
input into the band-pass filter 10. An output of the band-pass filter 10 is 
input into the amplitude adjuster 9. A signal obtained by adding a speed 

IS command compensatory signal Vrh as an output of the amplitude adjuster 9 
to die speed command basic signal Va is set as a new speed command Vr. 

A principle for suppression of vibration of a position loop will be 
described below. 

The gain of the all-pass filter is always 1 though the phase varies 
20 according to change in filter parameter and firequency. Because the 
all-pass filter in this embodiment is used as an exclusive phase adjuster, the 
band-pass filter need not be xised for phase adjustment. Accordingly, the 
band-pass filter can be configured so that the center firequency fo of the pass 
band in the band-pass filter coincides with the oscillation firequency £i of the 
25 position loop. When, for example, the aU-pass filter and the bandi)ass 
filter are constituted by a linear filter ((3-<0d)/(s+<»d), fi)d=27c£i) and a 
combination of a one-stage low-pass filter (l/(l+Tfs)) and a one-stage 
high-pass filter (Tfs/Cl+Tfs)) respectively in the case where the osdllation 
firequency fd of the position loop is 40 Bfe, the center firequency £> of the pass 
30 band in the band-pass filter is 40 Hz (Fig. 7) because a phase delay of 90° is 
given to a point of 40 Hz* The finear all-pass filter can be constituted by a 
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siniple low-pass filter represented by the following expression. 
[Expression 2] 

-1-2 - (2) 



In this manner, even in the case where the gain of the speed 
controller is low, VLd (= Vl - V,) contains a low-frequency component. The 
low-frequency component is however removed by the bandTass filter 
because the center firequency £> of the pass band in the band-pass filter is 
high as described above. When a sigiial <rf a frequency 6 contained in Vid 
passes through the aU-pass filter and the ampKtude a<«uster. the phase and 
gain of the signal are adjusted to cancel the vibration mode contained in the 
speed command basic signal Accordingly, when the speed command 
15 compensatory signal V,i is added to the speed command basic signal Vrf., the 
vibration of the position loop is suppressed so that low-frequency vibration 
or overshooting can be avoided (Fig. 10). 

A third embodiment of the invention will be described with reference 
to Fig. 3. A control system shown in Kg. 3 is configured by addition of an 
equivalent rigid system speed loop model 12 and an aH-pass filter 11 to the 
control system (Kg. 5) in the related art. In Kg. 3, a difference signal Vu 
obtained by subtracting an output Vlo of the equivalent rigid system ^eed 
loop model 12 from a load i^eed signal Vl is input into the all-pass filter 11. 
An output of the all-pass filter 11 is input into the band-pass filter 10. An 
output of the band-pass filter 10 is mput into the amplitude adjuster 9. A 
signal obtained by adding a speed command compensatory signal Va as an 
output of the ampKtude adjuster 9 to the speed command basic signal Vh, is 
set as a new speed command Vr. 

A principle for suppression of vibration of a position loop wiH be 
30 described below. 

For the same reason as in the first embodiment, when there is neither 
disturbance nor identification error, Via contains no signal but a vibration 
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signal COrequency- £i) of load speed. For the same reason as in the second 
embodiment, even when there is disturbance or identification error, all 
components except the oscillation frequency fd of the position loop are 
removed after passing through the band-pass filter. Finally* ihe vibration 
5 of the position loop can be suppressed^ so that low-ficeqxiency vibration or 
overshooting can be avoided. 

As described above, in accordance with the invention, the vibration 
signal of the position loop contained in the speed command basic s^nal is 
canceUed by the speed command compensatory signal, so that the gain of 
10 the position loop can be increased. In addition, because the speed loop 
model or the all-pass filter is added, low-firequency vibration or overshooting 
can be avoided* That is, speedy and accurate positioning can be achieved. 
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